#include <cstdint>
#include <cstring>
#include <iomanip>
#include <stdio.h>


void printt(uint8_t array[16][16]) {
	for (int i = 0; i < 16; ++ i) {
		// std::cout << '\n';
		for (int j = 0; j < 16; ++ j) {
			printf("0x%02x, ", array[i][j]);
		}
	}
	std::cout << '\n';
}

struct word{ 
	uint8_t wordKey[4];
};

struct AES_CTX {
	word Rcon[11];
	word expansionKey[44];
	word cipherText[4];
	unsigned int AES_TYPE;

	static const uint8_t SBox[16][16];
	static const uint8_t invSBox[16][16];
	static const uint8_t mixColumnMatrix[4][4];
	static const uint8_t invmixColumnMatrix[4][4];
	uint8_t T1[16][16], T2[16][16], T3[16][16];
	uint8_t T9[16][16], TB[16][16], TD[16][16], TE[16][16];

};
AES_CTX* AES_new();
void AES_init(AES_CTX* &ctx, uint8_t* key, unsigned int keyLen);
void AES_Encryption(AES_CTX* &ctx, uint8_t* input, uint8_t* output, unsigned int msgLen);
void AES_Decryption(AES_CTX* &ctx, uint8_t* input, uint8_t* output, unsigned int msgLen);
void AES_free(AES_CTX* &ctx);

void initRcon(AES_CTX* &ctx);
word rotWord(word w);
word subWord(word w, const uint8_t SBox[16][16]);
word wordXOR(word w1, word w2);
void keyExpansion(AES_CTX* &ctx, uint8_t* key);
void tTableGen(AES_CTX* &ctx);

void addRoundKey(AES_CTX* &ctx, int round);
void subBytes(AES_CTX* &ctx);
void shiftRows(AES_CTX* &ctx);
void mixColumns(AES_CTX* &ctx);
void mixSubColumns(AES_CTX* &ctx);// 合并列混合、字节代换
void invSubBytes(AES_CTX* &ctx);
void invShiftRows(AES_CTX* &ctx);
void invMixColumns(AES_CTX* &ctx);
void invMixSubColumns(AES_CTX* &ctx);// 合并逆列混合、逆字节代换
uint8_t GFMultiplyByte(uint8_t L, uint8_t R);

AES_CTX* AES_new() {
	return new AES_CTX;
}

void AES_init(AES_CTX* &ctx, uint8_t* key, unsigned int keyLen) {
	initRcon(ctx);
	ctx->AES_TYPE = keyLen;
	keyExpansion(ctx, key);
	tTableGen(ctx);
}

void AES_Encryption(AES_CTX* &ctx, uint8_t* input, uint8_t* output, unsigned int msgLen) {
    int paddedLen = (16 - (msgLen % 16)) + msgLen;
    int paddedVal = paddedLen - msgLen;
    uint8_t* paddedInput = new uint8_t[paddedLen];

    memcpy(paddedInput, input, msgLen);
    
    for (int i = msgLen; i < paddedLen; ++i)
        paddedInput[i] = paddedVal;
    
    for (int block = 0; block < paddedLen; block += 16) {
        for (int i = 0; i < 4; ++i)
            for (int j = 0; j < 4; ++j)
                ctx->cipherText[i].wordKey[j] = paddedInput[block + j + 4 * i];
                
        addRoundKey(ctx, 0);
        for (int i = 1; i < 10; ++i) {
            shiftRows(ctx);
			// subBytes(ctx);
            // mixColumns(ctx);
			mixSubColumns(ctx);
            addRoundKey(ctx, i);
        }
		subBytes(ctx);
        shiftRows(ctx);
        addRoundKey(ctx, 10);
        
        for (int i = 0; i < 4; ++i)
            for (int j = 0; j < 4; ++j)
                output[block + j + 4 * i] = ctx->cipherText[i].wordKey[j];
    }
    delete[] paddedInput;
}

void AES_Decryption(AES_CTX* &ctx, uint8_t* input, uint8_t* output, unsigned int msgLen) {
    for (int block = 0; block < msgLen; block += 16) {
        for (int i = 0; i < 4; ++i)
            for (int j = 0; j < 4; ++j)
                ctx->cipherText[i].wordKey[j] = input[block + j + 4 * i];
                
        addRoundKey(ctx, 10);
		invSubBytes(ctx);
		invShiftRows(ctx);
        for (int i = 9; i > 0; --i) {
            addRoundKey(ctx, i);
            invMixSubColumns(ctx);
			// invSubBytes(ctx);
			invShiftRows(ctx);
        }
        addRoundKey(ctx, 0);

        for (int i = 0; i < 4; ++i)
            for (int j = 0; j < 4; ++j)
                output[block + j + 4 * i] = ctx->cipherText[i].wordKey[j];
    }
    int paddedVal = output[msgLen - 1];
	for (int i = 1; i <= paddedVal; ++i) {
		output[msgLen - i] = 0;
	}
}


void AES_free(AES_CTX* &ctx) {
    if (ctx) {
        delete ctx;
        ctx = nullptr;
    }
}

void initRcon(AES_CTX* &ctx) {
	for (int i = 0; i < 4; ++i)
		for (int j = 0; j < 4; ++j)
			ctx->Rcon[i].wordKey[j] = 0x0;
	ctx->Rcon[1].wordKey[0] = 0x01;
	ctx->Rcon[2].wordKey[0] = 0x02;
	ctx->Rcon[3].wordKey[0] = 0x04;
	ctx->Rcon[4].wordKey[0] = 0x08;
	ctx->Rcon[5].wordKey[0] = 0x10;
	ctx->Rcon[6].wordKey[0] = 0x20;
	ctx->Rcon[7].wordKey[0] = 0x40;
	ctx->Rcon[8].wordKey[0] = 0x80;
	ctx->Rcon[9].wordKey[0] = 0x1b;
	ctx->Rcon[10].wordKey[0] = 0x36;
}

word rotWord(word w) {
	word temp;
	for (int i = 0; i < 4; ++i)	{
		temp.wordKey[(i + 3) % 4] = w.wordKey[i];
	}
	return temp;
}

word subWord(word w, const uint8_t SBox[16][16]) {
	uint8_t L, R;
	for (int i = 0; i < 4; ++i) {
		L = w.wordKey[i] >> 4;
		R = w.wordKey[i] & 0x0f;
		w.wordKey[i] = SBox[L][R];
	}
	return w;
}

word wordXOR(word w1, word w2) {
	word temp;
	for (int i = 0; i < 4; ++i) {
		temp.wordKey[i] = w1.wordKey[i] ^ w2.wordKey[i];
	}
	return temp;
}

void keyExpansion(AES_CTX* &ctx, uint8_t* key) {
	word temp;
	for (int i = 0; i < 4; ++i) {
		for (int j = 0; j < 4; ++j) {
			ctx->expansionKey[i].wordKey[j] = key[j + 4 * i];
		}
	}
	for (int i = 4; i < 44; ++i) {
		temp = ctx->expansionKey[i - 1];
		if (!(i % 4)) {
			temp = rotWord(temp);
			temp = subWord(temp, ctx->SBox);
			temp = wordXOR(temp, ctx->Rcon[i / 4]);
		}
		ctx->expansionKey[i] = wordXOR(ctx->expansionKey[i - 4], temp);
	}
}

void tTableGen(AES_CTX* &ctx) {
	for (int i = 0; i < 16; ++ i) {
		for (int j = 0; j < 16; ++ j) {
			ctx->T1[i][j] = GFMultiplyByte(0x01, AES_CTX::SBox[i][j]);
			ctx->T2[i][j] = GFMultiplyByte(0x02, AES_CTX::SBox[i][j]);
			ctx->T3[i][j] = GFMultiplyByte(0x03, AES_CTX::SBox[i][j]);
			ctx->T9[i][j] = GFMultiplyByte(0x09, i * 16 + j);
			ctx->TB[i][j] = GFMultiplyByte(0x0B, i * 16 + j);
			ctx->TD[i][j] = GFMultiplyByte(0x0D, i * 16 + j);
			ctx->TE[i][j] = GFMultiplyByte(0x0E, i * 16 + j);
		}
	}
}

void addRoundKey(AES_CTX* &ctx, int round) {
	for (int i = 0; i < 4; ++i)
		for (int j = 0; j < 4; ++j)
			ctx->cipherText[i].wordKey[j] ^= ctx->expansionKey[i + 4 * round].wordKey[j];
}

void subBytes(AES_CTX* &ctx) {
	uint8_t index, L, R;
	for (int i = 0; i < 4; ++i)	{
		for (int j = 0; j < 4; ++j)	{
			index = ctx->cipherText[i].wordKey[j];
			L = index >> 4;
			R = index & 0x0f;
			ctx->cipherText[i].wordKey[j] = ctx->SBox[L][R];
		}
	}
}

void shiftRows(AES_CTX* &ctx) {
	word temp[4];
	for (int i = 0; i < 4; ++i) {
		for (int j = 0; j < 4; ++j)	{
			temp[i].wordKey[j] = ctx->cipherText[(i + j) % 4].wordKey[j];
		}
	}
	for (int i = 0; i < 4; ++i)
		for (int j = 0; j < 4; ++j)
			ctx->cipherText[i].wordKey[j] = temp[i].wordKey[j];
}

void mixColumns(AES_CTX* &ctx) {
	word temp[4];
	for (int i = 0; i < 4; ++i)	{
		for (int j = 0; j < 4; ++j) {
			temp[i].wordKey[j] = GFMultiplyByte(ctx->mixColumnMatrix[j][0], ctx->cipherText[i].wordKey[0]);
			for (int k = 1; k < 4; ++k) {
				temp[i].wordKey[j] ^= GFMultiplyByte(ctx->mixColumnMatrix[j][k], ctx->cipherText[i].wordKey[k]);
			}
		}
	}
	for (int i = 0; i < 4; ++i)
		for (int j = 0; j < 4; ++j)
			ctx->cipherText[i].wordKey[j] = temp[i].wordKey[j];
}

void mixSubColumns(AES_CTX* &ctx) {
	word temp[4];
    for (int i = 0; i < 4; ++i) {
		uint8_t b0 = ctx->cipherText[i].wordKey[0];
		uint8_t b1 = ctx->cipherText[i].wordKey[1];
		uint8_t b2 = ctx->cipherText[i].wordKey[2];
		uint8_t b3 = ctx->cipherText[i].wordKey[3];

        temp[i].wordKey[0] = ctx->T2[b0 >> 4][b0 & 0x0F] ^
                             ctx->T3[b1 >> 4][b1 & 0x0F] ^
                             ctx->T1[b2 >> 4][b2 & 0x0F] ^
                             ctx->T1[b3 >> 4][b3 & 0x0F];
        temp[i].wordKey[1] = ctx->T1[b0 >> 4][b0 & 0x0F] ^
                             ctx->T2[b1 >> 4][b1 & 0x0F] ^
                             ctx->T3[b2 >> 4][b2 & 0x0F] ^
                             ctx->T1[b3 >> 4][b3 & 0x0F];
        temp[i].wordKey[2] = ctx->T1[b0 >> 4][b0 & 0x0F] ^
                             ctx->T1[b1 >> 4][b1 & 0x0F] ^
                             ctx->T2[b2 >> 4][b2 & 0x0F] ^
                             ctx->T3[b3 >> 4][b3 & 0x0F];
        temp[i].wordKey[3] = ctx->T3[b0 >> 4][b0 & 0x0F] ^
                             ctx->T1[b1 >> 4][b1 & 0x0F] ^
                             ctx->T1[b2 >> 4][b2 & 0x0F] ^
                             ctx->T2[b3 >> 4][b3 & 0x0F];
    }

	for (int i = 0; i < 4; ++i)
		for (int j = 0; j < 4; ++j)
			ctx->cipherText[i].wordKey[j] = temp[i].wordKey[j];
}

void invSubBytes(AES_CTX* &ctx) {
	uint8_t index, L, R;
	for (int i = 0; i < 4; ++i)	{
		for (int j = 0; j < 4; ++j)	{
			index = ctx->cipherText[i].wordKey[j];
			L = index >> 4;
			R = index & 0x0f;
			ctx->cipherText[i].wordKey[j] = ctx->invSBox[L][R];
		}
	}
}

void invShiftRows(AES_CTX* &ctx) {
	word temp[4];
	for (int i = 0; i < 4; ++i)	{
		for (int j = 0; j < 4; ++j)	{
			temp[i].wordKey[j] = ctx->cipherText[(i - j + 4) % 4].wordKey[j];
		}
	}
	for (int i = 0; i < 4; ++i)
		for (int j = 0; j < 4; ++j)
			ctx->cipherText[i].wordKey[j] = temp[i].wordKey[j];
}

void invMixColumns(AES_CTX* &ctx) {
	word temp[4];
	for (int i = 0; i < 4; ++i)	{
		for (int j = 0; j < 4; ++j)	{
			temp[i].wordKey[j] = GFMultiplyByte(ctx->invmixColumnMatrix[j][0], ctx->cipherText[i].wordKey[0]);
			for (int k = 1; k < 4; ++k)	{
				temp[i].wordKey[j] ^= GFMultiplyByte(ctx->invmixColumnMatrix[j][k], ctx->cipherText[i].wordKey[k]);
			}
		}
	}
	for (int i = 0; i < 4; ++i)
		for (int j = 0; j < 4; ++j)
			ctx->cipherText[i].wordKey[j] = temp[i].wordKey[j];
}

void invMixSubColumns(AES_CTX* &ctx) {
    word temp[4];
    for (int i = 0; i < 4; ++i) {
        uint8_t b0 = ctx->cipherText[i].wordKey[0];
        uint8_t b1 = ctx->cipherText[i].wordKey[1];
        uint8_t b2 = ctx->cipherText[i].wordKey[2];
        uint8_t b3 = ctx->cipherText[i].wordKey[3];

        temp[i].wordKey[0] = ctx->TE[b0 >> 4][b0 & 0x0F] ^
                             ctx->TB[b1 >> 4][b1 & 0x0F] ^
                             ctx->TD[b2 >> 4][b2 & 0x0F] ^
                             ctx->T9[b3 >> 4][b3 & 0x0F];
        temp[i].wordKey[1] = ctx->T9[b0 >> 4][b0 & 0x0F] ^
                             ctx->TE[b1 >> 4][b1 & 0x0F] ^
                             ctx->TB[b2 >> 4][b2 & 0x0F] ^
                             ctx->TD[b3 >> 4][b3 & 0x0F];
        temp[i].wordKey[2] = ctx->TD[b0 >> 4][b0 & 0x0F] ^
                             ctx->T9[b1 >> 4][b1 & 0x0F] ^
                             ctx->TE[b2 >> 4][b2 & 0x0F] ^
                             ctx->TB[b3 >> 4][b3 & 0x0F];
        temp[i].wordKey[3] = ctx->TB[b0 >> 4][b0 & 0x0F] ^
                             ctx->TD[b1 >> 4][b1 & 0x0F] ^
                             ctx->T9[b2 >> 4][b2 & 0x0F] ^
                             ctx->TE[b3 >> 4][b3 & 0x0F];
    }
    for (int i = 0; i < 4; ++i) {
        for (int j = 0; j < 4; ++j) {
            ctx->cipherText[i].wordKey[j] = ctx->invSBox[temp[i].wordKey[j] >> 4][temp[i].wordKey[j] & 0x0F];
        }
    }
}

uint8_t GFMultiplyByte(uint8_t m, uint8_t c) {
    uint8_t result = 0;
    uint8_t hi_bit_set;
    
    for (int i = 0; i < 8; ++i) {
        if (c & 1) {
            result ^= m;
        }
        hi_bit_set = (m & 0x80);
        m <<= 1;
        if (hi_bit_set) {
            m ^= 0x1b;
        }
        c >>= 1;
    }
    return result;
}

const uint8_t AES_CTX::SBox[16][16] = {
	{0x63, 0x7c, 0x77, 0x7b, 0xf2, 0x6b, 0x6f, 0xc5, 0x30, 0x01, 0x67, 0x2b, 0xfe, 0xd7, 0xab, 0x76},
	{0xca, 0x82, 0xc9, 0x7d, 0xfa, 0x59, 0x47, 0xf0, 0xad, 0xd4, 0xa2, 0xaf, 0x9c, 0xa4, 0x72, 0xc0},
	{0xb7, 0xfd, 0x93, 0x26, 0x36, 0x3f, 0xf7, 0xcc, 0x34, 0xa5, 0xe5, 0xf1, 0x71, 0xd8, 0x31, 0x15},
	{0x04, 0xc7, 0x23, 0xc3, 0x18, 0x96, 0x05, 0x9a, 0x07, 0x12, 0x80, 0xe2, 0xeb, 0x27, 0xb2, 0x75},
	{0x09, 0x83, 0x2c, 0x1a, 0x1b, 0x6e, 0x5a, 0xa0, 0x52, 0x3b, 0xd6, 0xb3, 0x29, 0xe3, 0x2f, 0x84},
	{0x53, 0xd1, 0x00, 0xed, 0x20, 0xfc, 0xb1, 0x5b, 0x6a, 0xcb, 0xbe, 0x39, 0x4a, 0x4c, 0x58, 0xcf},
	{0xd0, 0xef, 0xaa, 0xfb, 0x43, 0x4d, 0x33, 0x85, 0x45, 0xf9, 0x02, 0x7f, 0x50, 0x3c, 0x9f, 0xa8},
	{0x51, 0xa3, 0x40, 0x8f, 0x92, 0x9d, 0x38, 0xf5, 0xbc, 0xb6, 0xda, 0x21, 0x10, 0xff, 0xf3, 0xd2},
	{0xcd, 0x0c, 0x13, 0xec, 0x5f, 0x97, 0x44, 0x17, 0xc4, 0xa7, 0x7e, 0x3d, 0x64, 0x5d, 0x19, 0x73},
	{0x60, 0x81, 0x4f, 0xdc, 0x22, 0x2a, 0x90, 0x88, 0x46, 0xee, 0xb8, 0x14, 0xde, 0x5e, 0x0b, 0xdb},
	{0xe0, 0x32, 0x3a, 0x0a, 0x49, 0x06, 0x24, 0x5c, 0xc2, 0xd3, 0xac, 0x62, 0x91, 0x95, 0xe4, 0x79},
	{0xe7, 0xc8, 0x37, 0x6d, 0x8d, 0xd5, 0x4e, 0xa9, 0x6c, 0x56, 0xf4, 0xea, 0x65, 0x7a, 0xae, 0x08},
	{0xba, 0x78, 0x25, 0x2e, 0x1c, 0xa6, 0xb4, 0xc6, 0xe8, 0xdd, 0x74, 0x1f, 0x4b, 0xbd, 0x8b, 0x8a},
	{0x70, 0x3e, 0xb5, 0x66, 0x48, 0x03, 0xf6, 0x0e, 0x61, 0x35, 0x57, 0xb9, 0x86, 0xc1, 0x1d, 0x9e},
	{0xe1, 0xf8, 0x98, 0x11, 0x69, 0xd9, 0x8e, 0x94, 0x9b, 0x1e, 0x87, 0xe9, 0xce, 0x55, 0x28, 0xdf},
	{0x8c, 0xa1, 0x89, 0x0d, 0xbf, 0xe6, 0x42, 0x68, 0x41, 0x99, 0x2d, 0x0f, 0xb0, 0x54, 0xbb, 0x16}
};

const uint8_t AES_CTX::invSBox[16][16] = {
	{0x52, 0x09, 0x6a, 0xd5, 0x30, 0x36, 0xa5, 0x38, 0xbf, 0x40, 0xa3, 0x9e, 0x81, 0xf3, 0xd7, 0xfb},
	{0x7c, 0xe3, 0x39, 0x82, 0x9b, 0x2f, 0xff, 0x87, 0x34, 0x8e, 0x43, 0x44, 0xc4, 0xde, 0xe9, 0xcb},
	{0x54, 0x7b, 0x94, 0x32, 0xa6, 0xc2, 0x23, 0x3d, 0xee, 0x4c, 0x95, 0x0b, 0x42, 0xfa, 0xc3, 0x4e},
	{0x08, 0x2e, 0xa1, 0x66, 0x28, 0xd9, 0x24, 0xb2, 0x76, 0x5b, 0xa2, 0x49, 0x6d, 0x8b, 0xd1, 0x25},
	{0x72, 0xf8, 0xf6, 0x64, 0x86, 0x68, 0x98, 0x16, 0xd4, 0xa4, 0x5c, 0xcc, 0x5d, 0x65, 0xb6, 0x92},
	{0x6c, 0x70, 0x48, 0x50, 0xfd, 0xed, 0xb9, 0xda, 0x5e, 0x15, 0x46, 0x57, 0xa7, 0x8d, 0x9d, 0x84},
	{0x90, 0xd8, 0xab, 0x00, 0x8c, 0xbc, 0xd3, 0x0a, 0xf7, 0xe4, 0x58, 0x05, 0xb8, 0xb3, 0x45, 0x06},
	{0xd0, 0x2c, 0x1e, 0x8f, 0xca, 0x3f, 0x0f, 0x02, 0xc1, 0xaf, 0xbd, 0x03, 0x01, 0x13, 0x8a, 0x6b},
	{0x3a, 0x91, 0x11, 0x41, 0x4f, 0x67, 0xdc, 0xea, 0x97, 0xf2, 0xcf, 0xce, 0xf0, 0xb4, 0xe6, 0x73},
	{0x96, 0xac, 0x74, 0x22, 0xe7, 0xad, 0x35, 0x85, 0xe2, 0xf9, 0x37, 0xe8, 0x1c, 0x75, 0xdf, 0x6e},
	{0x47, 0xf1, 0x1a, 0x71, 0x1d, 0x29, 0xc5, 0x89, 0x6f, 0xb7, 0x62, 0x0e, 0xaa, 0x18, 0xbe, 0x1b},
	{0xfc, 0x56, 0x3e, 0x4b, 0xc6, 0xd2, 0x79, 0x20, 0x9a, 0xdb, 0xc0, 0xfe, 0x78, 0xcd, 0x5a, 0xf4},
	{0x1f, 0xdd, 0xa8, 0x33, 0x88, 0x07, 0xc7, 0x31, 0xb1, 0x12, 0x10, 0x59, 0x27, 0x80, 0xec, 0x5f},
	{0x60, 0x51, 0x7f, 0xa9, 0x19, 0xb5, 0x4a, 0x0d, 0x2d, 0xe5, 0x7a, 0x9f, 0x93, 0xc9, 0x9c, 0xef},
	{0xa0, 0xe0, 0x3b, 0x4d, 0xae, 0x2a, 0xf5, 0xb0, 0xc8, 0xeb, 0xbb, 0x3c, 0x83, 0x53, 0x99, 0x61},
	{0x17, 0x2b, 0x04, 0x7e, 0xba, 0x77, 0xd6, 0x26, 0xe1, 0x69, 0x14, 0x63, 0x55, 0x21, 0x0c, 0x7d}
};

const uint8_t AES_CTX::mixColumnMatrix[4][4] = {
	{0x02, 0x03, 0x01, 0x01},
	{0x01, 0x02, 0x03, 0x01},
	{0x01, 0x01, 0x02, 0x03},
	{0x03, 0x01, 0x01, 0x02}
};

const uint8_t AES_CTX::invmixColumnMatrix[4][4] = {
	{0x0e, 0x0b, 0x0d, 0x09},
	{0x09, 0x0e, 0x0b, 0x0d},
	{0x0d, 0x09, 0x0e, 0x0b},
	{0x0b, 0x0d, 0x09, 0x0e}
};